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.Abstract 

^We  suggest  th&t  there  ure  two  components  required  in 
most  control  schemes:  an  algorithmic  component  which 
takes  a  high-level  goal  and  generates  joint  trajectories, 
and  a  dynamics  component  which  takes ^hese  joint  trajec¬ 
tories  and  generates  the  required  joint  torques.  The  joint 
torques  are  then  sent  to  the  mechanism,  which  (hopefully) 
achieves  the  high-level  gosL 

We  present  an  approach  that  simplifies  the  program¬ 
ming  of  the  algorithmic  component  for  high  degree  of  free¬ 
dom  objecu.  Instead  of  supplying  a  complete  set  of  joint 
trajectories  as  a  function  of  time,  the  algorithm  controls 
other,  more  intuitive,  degrees  of  freedom.  TheM  degrees 
of  freedom  are  antomatieally  converted  to  the  more  con¬ 
ventional  Joint  trajectories.  iThe  algorithm  can  nndercon- 
strain  the  object,  injsJuchr'case  constrained  optimisation 
is  used  in'^nverting  to  joint  trajectories. 

^This  approach  is  applied  to  generate  joint  trajectories 
for  a  walking  biped.^The  walking  algorithm  is  presented 
along  with  the  results  from  testing  with  the  Mewton  sim¬ 


ulation  system. 


1  Introduction 


There  are  two  components  required  in  most  control 
schemes:  an  aigorithniie  component  and  a  dynamics  com¬ 
ponent.  The  algorithmic  component  generates  joint  tra¬ 
jectories  from  high-level  goals,  and  the  dynamics  compo¬ 
nent  generates  actantor  torques  from  the  joint  trajecto¬ 
ries. 

This  paper  deseribas  a  general  approach  that  simplifies 
the  algorithmic  component  of  the  control  scheme.  The 
approach  advocates  the  selection  of  a  small  set  of  intu¬ 
itive  variables  which  are  used  by  the  algorithm  in  control¬ 
ling  the  object.  These  degrees  of  freedom  are  automati¬ 
cally  converted  into  the  more  conventioaal  joint  .variables. 
In  the  event  that  the  algorithm  underconstrains  the  mo¬ 
tion  of  the  object,  constrained  optimisation  techniques 
are  used  to  chooee  a  motion  that  optimises  some  criterion 
while  satisfying  the  constraints  imposed  by  the  algorithm. 

This  paper  does  not  consider  the  dynamics  component 
of  the  control  scheme.  However,  inverse  dynamics  is  used 
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in  the  algorithmic  component,  and  joint  torques  are  gen¬ 
erated  as  a  side  effect;  these  are  the  torques  required  to 
control  the  ideal,  simulated,  object.  We  do  not  expect 
these  torques  to  have  much  similarity  with  those  required 
to  control  a  real  object,  and  hence  treat  the  dynamics 
component  as  a  separate,  unsolved,  problem. 

We  demonstrate  the  algorithmic  approach  by  program¬ 
ming  a  sixteen  degree  of  freedom  anthropomorphic  biped. 
The  resulting  slgorithm  generates  realistic  joint  trajecto¬ 
ries  and  haa  been  teated  on  the  Newton  simnlation  system 
with  favorable  resnlts. 


2  Motivation 

Varions  approaches  have  been  taken  to  reduce  the  com¬ 
plexity  of  high-level  control  programs.  The  computed 
torque  method  for  robot  anas  (see  [1])  can,  in  our  view 
be  thought  of  as  simplifying  control  by  splitting  the  prob¬ 
lem  into  two  components:  sa  algorithmic  component  and 
a  dynamics  component.  The  algorithmic  component  can 
ignore  the  dyanmics  of  the  robot  arm,  only  concerning 
itself  with  the  pontioa  of  the  end  effector  as  s  function 
of  time.  The  dynamics  component  can  ignore  the  high- 
level  goal,  only  concerning  itself  with  generating  torques 
to  achieve  the  specified  end  effector  trajectory. 

In  building  his  one-legged  bopping  machine,  Raibert  [8] 
partitioned  control  along  three  intuitive  degrees  of  free¬ 
dom:  hopping,  forward  speed  and  body  posture.  This 
resulted  in  surprisiagiy  simple  control  programs  for  the 
hopping  robot.  For  multi-legged  machines.  Raibert  in- 
trt^uced  the  idea  of  a  ‘Wiitual  leg”  which  was  defined 
in  terms  of  the  robot’s  phjrsical  legs.  This  again  led  to 
simplified  control  programs. 

Both  the  computed  torque  method  sad  Raibert 's  vir¬ 
tual  leg  demonstrate  that  a  proper  choice  of  control  vati- 
ablet  can  lead  to  amplified  control.  We  believe  that  by 
partitioning  the  control  problem  into  s/^onthm  and  dy¬ 
namics,  and  by  choosing  an  intuitive  set  of  control  vari¬ 
ables,  relatively  complex  objecu  can  be  controlled  wuh 
greater  ease. 

Pllferent  methods  have  been  used  to  deal  with  high 
degree  of  freedom  objecu.  Some  control  programs  for  re¬ 
dundant  mnnipulaton  use  the  extra  degrees  of  freedom  to 
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Figure  1:  The  Format  of  an  Algorithm 


giving  the  algorithm  access  to  these  force  and  torque 
quantities^.  The  algorithm  could,  for  example,  spe^y 
the  amount  of  force  required  between  two  objects  while 
at  the  same  time  specifjring  the  acceleration  of  some  other 
object.  A  concrete  example  is  a  hnmanoid  robot  hurling 
a  ball.  The  algorithm  could  specify  fifty  pounds  of  force 
between  the  ball  and  the  hand  (in  some  direction),  and 
could  simulataneously  require  that  the  center  of  mass  of 
the  robot  remain  at  rest. 

Figure  1  shows  the  format  of  a  control  algorithm.  For 
the  sake  of  clarity  the  algorithms  win  be  described  in  a 
Pascal-like  notation.  Two  procedures  ate  always  present: 
one  to  initialize  the  algorithm  (called  iait  inline)  and 
one  to  be  executed  repeatedly  over  the  course  of  the  task 
(called  eentreller).  The  eentreller  procedure  has  ac¬ 
cess  to  the  complete  state  of  the  system.  The  algorithm 
of  Figure  1  triviaUy  defines  and  controls  a«m.  the  accel¬ 
eration  of  the  center  of  mass  of  an  object  (the  function  / 
must  be  defined  elsewhere). 

Defining  and  controlling  a  vectorial  quantity  like  the 
acceleration  of  the  center  of  mass  has  the  effect  of  adding 
three  constraint  equations  to  Newton's  system  of  simul¬ 
taneous  linear  equations  that  describe  the  instantaneous 
motion  of  the  object.  By  considering  joint  torques  as  un. 
knowfu  in  this  augmented  system  of  equations,  the  system 
can  be  solved  to  produce  values  for  these  torques  -  and  for 
the  unknown  forces  and  object  accelcratioas  -  that  sat¬ 
isfy  the  additional  constraint  eqnations.  This  is  a  simple 
application  of  inverse  dynamics. 

In  controlling  a  real  object,  the  object  accelerations 
would  be  used  to  directly  compute  the  joint  accelerations. 
These  joint  accelerations  would  be  given  to  the  dynamtet 
component,  which  would  calculate  the  torques  required 
to  achieve  these  aeeelerations.  In  our  Newton  simulation, 
however,  the  object  aooeleratioas  ate  simply  integrated 
over  time  to  prodnee  the  simulated  motion. 

For  an  object  with  n  degrees  of  freedom  the  control  al¬ 
gorithm  can  define  and  control  up  to  a  independent  scalar 
quantities^.  If  fewer  than  n  eqnations  are  added,  the  sya- 

‘  A  sunpler  approach  might  ba  to  let  the  algorithm  specify 
pesiriaae/  constraints  which  would  be  autonatically  diflereoti- 
atad  by  Newton  to  obtain  tha  second  darivatives. 

^The  additional  dafiaitional  aquaiiona  could  make  tha  ajr^ 
tam  of  motion  aqtiationa  inconsistant.  Thia  would  ba  an  error 
on  tbo  part  of  tha  control  algorithm. 


tern  of  motion  eqnations  ia  nnderdetermined  and  many 
different  solutions  could  satisfy  the  constraints  of  the  con¬ 
trol  algorithm.  In  this  case  the  algorithm  must  guide  the 
selection  of  a  solution  by  providing  a  cost  function  which 
is  quadratic  in  the  unknowns.  A  standard  numerical  op¬ 
timization  technique  is  used  to  compute  a  solution  that 
minimizes  the  cost  function  while  obeying  the  algorithm  s 
constrainu. 

In  summary,  the  programmer  designs  an  algorithm  in  a 
high-level  computer  language  to  control  intuitive  degrees 
of  freedom  of  the  object.  These  degrees  of  freedom  are 
defined  as  linear  combinations  of  the  unknowns  in  the 
object’s  equations  of  motion.  An  augmented  linear  system 
of  equations  describes  the  instantaneous  behavior  of  the 
object;  this  system  can  be  solved  to  produce  the  Joint 
accelerations  required  to  achieve  the  desired  motion.  If 
the  system  is  underdetermined,  the  algorithm  can  provide 
a  cost  function  to  guide  the  choice  of  a  solution. 

In  the  remaining  sections  we  describe  the  application 
of  this  approach  to  the  design  of  a  simple  walking  algo¬ 
rithm. 


5  Trajectory  Generation 

In  designing  algorithms  with  Newton,  we  found  ourselves 
frequently  using  PD  controUets  and  cuve-littiag  cos- 
UoUera  to  generate  the  trajectory  of  many  of  the  defined 
quantities.  Unlike  PD  controllers  used  with  resl  objects, 
our  “controUen*  amply  generated  the  second  derivative 
of  a  quantity  as  a  function  of  time.  To  avoid  confusion 
we  will  call  them  *trajectory  generators*.  The  program- 
mer  can  make  use  of  trajectory  generators  to  specify  the 
trajectories  of  the  intuitive  control  variables. 

In  the  biped  algorithm,  for  example,  a  quintic  curve 
generator  is  used  for  the  trajectory  of  the  heel,  and  a 
PD  generator  is  used  to  orient  the  foot  before  it  strikes 
the  ground.  The  PD  generator  defines  the  foot’s  angular 
acceleration  as  a  function  of  time  until  the  foot  strikes  the 
gronnd.  A  small  library  of  these  trajectory  generators  is 
used  in  the  biped  algorithm,  and  will  be  described  here. 

PD  generators  ate  used  ia  the  biped  algorithm  to  con¬ 
trol  orientation,  position  and  Joint  angle.  Each  genera¬ 
tor  adds  an  equation  to  the  system  of  motion  eqnations 
that  defines  the  second  derivative  of  the  quantity  in  terms 
of  the  first  derivative  and  the  quantity  itself.  The  pro¬ 
cedure  m  Figure  2  produces  accelerations  to  move  an  1 
object  to  within  of  a  poaition  x-dasixed  within  a 
given  time  delta-tiae.  Tlie  qnaatitiea  s,  v  and  a  ate 
data  structures  representing  state  variables  of  the  con¬ 
trolled  object.  These  data  stnetnres  are  used  by  the 
add-aaaed*«qnatiea  function  to  create  the  appropriate 
equation.  ^ 

Execution  of  the  procedure  in  Figure  2  causes  a  nameo 
equation  to  be  added  to  the  system  of  motion  equations. 

This  equation  will  continue  to  affect  the  motion  of  the  ob-  — - - 

ject  until  it  is  explicitly  removed  by  the  control  algorithm. 

The  biped  algorithm  nsca  three  similar  trajectory 
generators:  orisnt-elth-PD,  sst-angle-eith-PO  and 
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Figure  4:  Walking  Cycle 
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Figure  5:  Newton  Statistical  Output 


biped  completes  a  full  cycle  of  the  six  phases  described 
above.  The  full  simulatioa  consisted  of  twenty  seconds  of 
straighUline  walking  at  varying  speeds  on  a  flat  sat&ee 
and  generated  the  statistics  shown  ia  Figure  S  (only  a 
portion  of  the  stmnlation  is  shown). 

Due  to  the  simplicity  of  our  current  biped  modd,  this 
algorithm  is  forced  to  use  many  constniats  to  achieve  the 
desired  motion.  In  particular,  the  trajectory  of  the  heel 
must  be  spedfled.  It  almost  seems  that  the  algorithmic 
approach  to  walking  is  at  least  as  ceapbeated  as  any  other 
approach.  Howerer,  if  the  biped  model  were  extended  to 
include  elastic  tendons  the  number  of  constraints  might 
be  reduced.  In  this  case,  the  swing  phase  would  not  have 
to  specify  a  trajectory  for  the  heeL  Instcnd,  no  torque 
would  be  applied  ia  the  siring  leg;  it  would  be  pulled 
forward  by  the  stored  energy  of  the  stretched  tendons. 
This  might  approximate  the  “bailistic  walking”  described 
by  McMahon(7l. 

We  fed  that  a  high-levd  algorithm  should  prentfy  un* 
derdetermine  the  motion  of  the  controlled  object.  Our 
philoeophy  is  to  iacorporau  in  the  modd  many  ^passive 
elemenu*  -  such  as  springs,  dampers  and  joint  limits  ' 
which  reduce  the  number  of  constraints  needed  by  the 
control  algorithm.  The  algorithm  then  has  the  job  of 


guiding,  rather  than  forcing,  the  motion  of  the  object 


8  Summary 

There  are  two  components  required  in  most  control 
schemes:  an  algorithmic  component  and  a  dynamics  com- 
ponent.  We  have  presented  a  general  approach  that  sim¬ 
plifies  the  programming  of  the  algorithmic  component. 
This  approach  allows  the  programmer  to  choose  intuitive 
degrees  of  freedom  by  which  to  control  an  object;  if  the 
motion  of  the  object  is  not  fully  determined  the  program¬ 
mer  can  define  a  quadratic  cost  function  which  is  mini¬ 
mised  subject  to  the  constraints  of  the  control  algorithm. 
We  believe  that  the  algorithm  should  greatly  undercon¬ 
strain  the  motion  by  relying  on  “passive  elements'*  of  the 
model. 

We  have  presented  an  algorithm  to  generate  Joint  tra¬ 
jectories  for  a  biped,  along  with  results  from  the  algo¬ 
rithm's  execution  on  the  Newton  simulatioa  system.  We 
do  not  expect  onr  algorithm  to  work  on  a  physical  biped. 
Rather,  we  are  usiag  this  example  to  demonstrate  the 
nsefulness  of  a  high>levd  algorithmic  approach  ia  control¬ 
ling  an  object.  An  algorithm  embodies  the  ideas  and  the 
structure  of  a  solution  to  a  given  problem.  We  believe 
that  controlling  complex  physical  objects  requires  a  struc- 
tnred,  algorithmic  approach  similar  to  that  presented  in 
this  paper. 
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avoid  obstacles  or  to  stay  away  from  singularities.  Work 
presented  in  [6]  uses  the  one>dimensional  nuU  space  of  the 
Jacobian  of  a  three  link  planar  arm  to  move  the  arm  into 
a  configuration  of  equal  joint  angles,  thereby  avoiding  sin¬ 
gularities  where  possible. 

Our  decision  to  allow  control  programs  to  undercon- 
strain  the  controlled  object  -  requiring  the  use  of  con¬ 
strained  optimization  techniques  -  is  based  on  the  belief 
that  researchers  will  soon  be  attempting  to  control  objects 
much  more  complex  than  robot  arms.  These  objects  will 
have  many  more  degrees  of  freedom  than  are  necessary 
to  their  control  programs.  A  robot  modeled  after  the  hu¬ 
man  figure  may  have  more  than  fifty  degrees  of  freedom 
[9],  while  the  control  program  for  such  a  robot  would  only 
require  twenty  or  thirty  degrees  of  freedom  to  accomplish 
its  task.  In  programming  our  anthropomorphic  robot  we 
needed  at  most  eleven  of  its  sixteen  degrees  of  freedom  at 
any  given  instant. 

In  summary,  with  the  algonthmie  approach  the  algo¬ 
rithm  constrains  a  set  of  intuitive  degrees  of  freedom  that 
are  defined  in  temu  of  the  conventional  degrees  of  free¬ 
dom  of  the  controlled  object.  The  algorithm  is  allowed  to 
underconstrain  the  motion  of  the  object,  in  which  case  a 
motion  is  chosen  which  minimizes  a  cost  function  while 
obeying  the  constraints. 

3  Overview  of  Newton 

The  algorithms  described  in  this  paper  have  been  designed 
and  tested  using  the  Sewtoa  simulation  system,  part  of  a 
large  research  effort  in  modeling  and  simulation  at  Cor¬ 
nell  Univeraity[5,2].  Using  Newton,  a  designer  can  define 
complex  physical  objects  and  can  represent  object  char¬ 
acteristics  from  a  wide  range  of  domains.  In  particular, 
a  dynamic  simulation  of  the  object  can  be  performed.  A 
more  detailed  description  of  Newton  can  be  found  in  [3], 
in  these  proceedings. 

An  object  is  modeled  as  a  eoOeetion  of  rigid  bodies 
related  by  constraints.  Newton-Euler  equations  of  motion 
are  associated  with  each  rigid  body.  At  the  time  an  object 
is  created  the  equations  are  of  the  form 
mf  w  mg 
Jli)  w  X  Jw  s  0. 

Constrained  relationships  between  objects  are  nor¬ 
mally  represented  by  data  structures  called  *iiinges.” 
A  speciftcation  that  two  objecu  ate  to  be  connected 
with  a  spherical  joint  is  met  by  the  addition  of 
one  vectorial  eoantiaiat  equation  and  the  sdditioa 
of  some  terms  to  the  motion  equations  of  the  con¬ 
strained  objecu.  Thus,  the  equations  above  become 
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where  c,-  is  the  vector  from  object  i’s  center  of  mass  to 
the  location  of  the  hinge  and  is  the  constraint  force 

that  keeps  the  objects  together.  Other  lands  of  hinges 
commonly  used  in  Newton  include  revolute  or  pin  joints, 
prismatic  joints,  springs  and  dampers,  and  rolling  con¬ 
tacts. 

The  motion  equations  are  collected  from  each  rigid 
body  and  assembled  into  a  system  of  equations  which  can 
be  solved  to  determine  instantaneous  accelerations  and 
hinge  constraint  forces.  Newton  integrates  the  derived 
accelerations  to  produce  the  motion  of  the  simulated  ob¬ 
ject. 

Newton,  unlike  many  other  simulation  systems  ( though 
see  [4]),  can  automatically  and  incrementally  reformulate 
the  motion  equations  sn  exceptional  events  occur  dunng 
simulations.  Two  examples  of  exceptional  events  are  im¬ 
pact  and  changing  kinematic  relationships  between  ob¬ 
jecu.  such  as  a  block  sliding  off  a  table.  These  changing 
contact  relationships  are  detected  automatically  by  .Vew- 
ton  and  the  system  of  motion  equations  and  the  related 
constraint  equations  are  automatically  maintained  to  re¬ 
flect  these  changing  relationship*.  This  is  explained  in 
more  detail  in  [3]. 

User-directed  influence  of  object  motion  is  supported  in 
part  through  control  forces  and  control  torques.  If  a  pro¬ 
grammer  wanu  to  associate  an  actuator  with  a  hinge  be¬ 
tween  two  objecu,  the  system  associates  a  control  torque 
quantity  with  the  hinge.  As  part  of  the  creation  of  this 
quantity,  the  sysum  modifies  the  motion  equations  of  the 
two  constrained  objecu,  adding  torque  terms  to  the  rele¬ 
vant  motion  equations. 

4  The  Algorithmic  Approach 

In  Newton  ’*  automatically-generated  equations  of  motion 
certain  quantities  are  considered  to  be  unknowns.  A  sys¬ 
tem  of  simultaneous  linear  equations  is  solved  at  each 
time  step  to  produce  values  for  the  unknowns.  These 
values  are  integrated  over  time  to  produce  the  simulated 
motion.  Typically,  the  unknowns  consist  of  sccelerations 
and  joint  constraint  forces,  while  positions,  velocities  and 
joint  control  torques  are  known#. 

In  the  algorithmic  approach,  the  programmer  controls 
‘Hntnitive*  quantities  defined  as  linear  combinations  of  the 
unknowns.  The  programmer  might,  for  example,  want 
to  control  the  acceleration  of  the  center  of  mass  of  a 
biped  without  explicitly  controlling  each  component  of  the 
biped.  To  do  this,  the  algorithm  must  define  the  scceler- 
ation  of  the  center  of  mess  in  terms  of  the  tcceierations 
of  the  centers  of  mass  of  the  primitive  components  of  the 
object.  Over  the  course  of  execution,  the  algorithm  must 
supply  the  desired  acceleration  of  the  center  of  mass. 

It  might  appear  needlessly  complicsud  to  require  the 
algorithm  to  control  the  second  derivative  of  a  variable 
(e.g.  acceleration)  rather  than  the  variable  itself  (e  g. 
position).  Doing  it  in  this  fashion,  however,  allows  the 
second  derivative  quantities  to  be  n^ated  to  the  force 
and  torque  quantities  in  Newton's  motioa  equations,  thus 
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Figure  2:  PD  Trajectory  Geaerator 


poaitioa-peiat-vith-^iatie.  Thia  Iwt  generator  plota 
a  quintic  trajectory  for  a  particular  point  on  an  object  (in 
our  caae,  the  heel  on  the  foot). 


6  The  Biped  Model 

The  sunolated  biped  is  composed  of  a  torso,  two  legs  with 
knee  jotnu  and  two  feet  with  toe  jointe.  This  model  was 
adapted  from  a  description  in  [7]  and  is  shown  in  Figure  3. 
The  hips  and  aaJclen  ace  three  degree  of  freedom  spherical 
joints,  while  the  knees  and  toes  are  one  degree  of  free* 
dom  revolute  joints,  making  a  total  of  sixteen  degrees  of 
freedom.  The  biped  is  about  six  feet  tail  with  momenw 
approximating  those  of  a  human  being. 

We  hope  to  improve  this  model  by  incorporating  joint 
Umits  and  elastic  tendons.  McMahon  suggests  that,  dur* 
ing  walking,  energy  is  stored  in  stretched  tendons  and  is 
released  when  the  stretched  leg  swings  forward  [7],  This 
idea  might  be  used  to  simplify  the  walking  algorithm  de¬ 
scribed  in  the  next  section. 

fiewton’a  impact  handling  capabilities  have  not  yet 
been  extended  to  accurately  modri  the  impact  of  the  feet 


Constraint  Name  dof  Constrained  Item 


Tatso-coisTuirr 

L-lIES-tICU 

t'BEEL-TXAJ 

I-FOOT-OEICITITZOI 

I-TOS-UCU 


3  torso  onemation 

1  knee  joint  an;ie 

3  heel  acceleration 

3  foot  orientation 

1  toe  joint  angle 


Table  1:  Swing  Phase  Constraints 


upon  the  ground.  Instead,  impact  is  simulated  by  adding 
an  external  force  and  torque  to  the  feet  that  holds  them 
level  with  the  ground  until  they  are  releaaed  with  an  ex¬ 
plicit  command  from  the  control  algorithm.  This  is  as 
though  the  biped  was  walking  with  magnetic  shoes  on  a 
steel  plate.  Very  shortly  we  expect  to  adapt  the  algorithm 
to  incorporate  realistic  impact. 


7  The  Walking  Algorithm 

An  abbreviated  version  of  the  walking  algorithm  is  shown 
in  Fignre  d  at  the  end  of  this  pnper.  The  algorithm  cycles 
through  a  set  of  six  statet*.  string  the  right  leg,  land  the 
right  foot,  lift  the  left  foot,  swing  the  left  leg,  land  the 
left  foot,  lift  the  tight  foot  and  then  repeat  the  cycle.  In 
the  swing  phaee,  a  qnintie  trajectory  is  plotted  for  the 
swing  foot  with  aeve-hsel-te-terget,  while  the  stance 
leg  is  stiffened  with  set-aagle-vitb-PD  and  the  foot  is 
oriented  for  landing  with  orient -witb-PD  (shown  under 
START  in  Fignre  6).  In  the  landinpphaae,  the  leading  leg  is 
stiffened  as  the  foot  nears  the  ground.  Following  this,  the 
takeoff  phase  Bexes  the  trailing  leg,  causing  the  trailing 
foot  to  lift  from  the  ground.  Once  the  trailing  toe  is  bent 
to  10  degrees  the  flexing  constraint  is  removed  and  the 
swing  phase  begias  for  the  trailing  leg. 

The  largest  number  of  constraints  is  applied  during  the 
swing  phase,  as  shown  in  Table  1.  Since  the  biped  has  six¬ 
teen  degrees  of  freedom  (dof)  it  remnias  uaderconstrained 
at  all  times.  A  quadratic  cost  function  is  therefore  defined 
(in  iaitialixe  of  Figure  6)  in  order  to  folly  determine 
the  motion  of  the  biped.  The  cost  function  is  a  weighted 
sam  of  the  ttaaslatioanl  and  angular  accelerations,  and  of 
the  difference  between  the  torso  translations!  acceleration 
and  an  acceleration  defined  by  a  function  F  that  tries  to 
keep  the  torso  mid-way  between  the  two  feet. 

We  found  that  a  coot  function  that  minimizes  tranv 
lational  and  rotational  aeceleratioa  nsnally  produces 
smooth  motion.  In  the  case  of  the  simttlsted  biped,  the 
cost  function  cnnscs  the  constrained  heel  scceleration  to 
be  achieved  by  a  tiacar  combination  of  smaU  accelerations 
of  many  compoaeata  of  the  body,  rather  than  a  few  large 
accelerations  of  those  components  that  are  near  the  heel. 
We  have  observed  that  the  combination  of  many  small 
accelerations  yields  more  stable  motion  than  large,  local 
accelerations. 

The  walking  algorithm  was  tested  with  the  iVewton  sim¬ 
ulation  system.  Fignre  4  shows  ten  frames  in  which  the 


camit 


ttaa-ia-tiz 

ttrida 

lliactioa 

latida*atap-f race ia> 

kaai*T>atTika>apaad 

haal>t*atrila-apaad 

faat-atTLka>ariaatatla> 

taraa-ariaatatiaa 


a  O.S  a 

■  O.S  a 
*(100) 

-  20  t 

>  -O.OS  a/a 

>  0.02  a/s 

■  10*  abaat  (0  0  t) 

■  -10*  abaat  (0  0  t) 


vor  pbasai  (  start  r-**ia|  r-Iaad  1-lift  1-tafeasff  l-asiaf  1-laad  r-lift  r-takasff  ) 


praeadara  aaaa-baal-ta-targatC  caastraiat-aaaa.  faat,  atbar-fsat,  kip,  athar-kip  ) 
tor  targat-t,  targat-a,  kip-ts-kip)  aactar 
bagia 

kip-ta-kip  :■  gat-paaitlaa(  TOISO,  kip  )  -  gat-pasitiaaC  TOkSO,  stkar-kip  ) 

targat-t  :*  gat-paaitiaa(  atksr-faat,  IIS.  )  *  atTlds  X  dixactiaa 
•  iaaida-atsp-fraetlaa  X  kip-ta-kip 

targat-a  :a  kaal-T-atrika-spaad  X  <0  1  0)  *  kasl-X-strlka-apaad  x  diractlaa 

p*aitiaa-paiat-*itk-^aatie<  dsastraiat-asaa.  fast,  IIS.  targat-x,  targat-a,  tias-ia-air  ) 
aad 


pxacadara  laitlalixs 

lad  F  a  —  aiaraa)  +'/f»(J'(/|_/aa*  +  ~  *«**•*) 

bagia 

taadialic.tsat  :*  +  20 F)* 

pkoaa  :*  STASt^ 


ptacadora  esatraUstl  tias  ) 
bagia 

sasa  pksaa  af 

STAKT: 

phosa  sa  B>aWUfG 

*ti*at-aith-ra(  TOIM-COnTUnr.  TOUO.  taraa-arlaatatiaa.  2.0  s  ) 
as**-h**i-ta-targ*t(  B-IIS-mj.  I-IIS.  l-IIS.  t-II?,  L-IIF  > 
a*t-aagi*«*tth-PO(  L-IIII-UIU.  L-sm.  ITS*.  0.1  a  > 

*ri*Bt-atU-ra(  t-rOOT-OIXOTSTiai.  I-rOOT,  faat-atrtka-arlaatatiaa.  tlaa-U-aar  ) 
adt-aagis-aath-reC  k-TOI-UOU.  k-TOI-iOXlT.  0*.  tiaa-ia-au  > 

■-3  WING  ■ 

if  diataaca-ta-targ*t(  I-POOT  )  <  O.OS  a  thoa 

pkoaa  !■  I-IANDING 
raasaa-taostraiotC  l-IIS-TUJ  ) 

sat-aagia-*itk-n(  l-Un-iMU.  1-011.  ITS*.  O.OC  s  ) 

S-lANDINGi 

if  kaal-kaa-taacksd<  B-noT  )  tboa 


pkasa  i*  UTAKEOFF 

raasaa«aaaatrauita(  B-POOT-OBXOTkTXOI.  B-TOI-0OU,  L-KB0-0IU  ) 
s*t-aa«is-*itb-m<  L-UO-UBU.  L-UO.  160*,  0.1  s  > 

I.TAXXOFF1 

U  istat-oiglaX  l-TDI-JOXIT  )  >  10*  tkaa 


ffeasa  sa  USWme 
r*a**s-t*astTaia«<  l-im-kMU  ) 

asa*-k**l-ta-targ*t(  1.-BOI.-TI12 .  L-IIS.  B-OS.  L-BW,  B-BIF  ) 

*rl*at-*ttb-00(  t-rOOT-flUmsTXW.  t-fOOT.  fsat-strika-ariaotstiaa.  tlaa-U-air  ) 
sat-aagla-aitb-ns  L-TOI-UOU.  bL-TOB-iOXaT.  IBO*,  tUta-ia-atr  ) 

Csss*  L-SWING.  L.IANOING.  sad  X-TAXEOFF 
srt  sasiofass  I*  <k*  pfaesdiaf  ikrts  cast*. 


Figure  0;  Abbreviated  Walkiog  Algorithm 


